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Abstract — This paper provides new results for a robust 
adaptive tracking control of the attitude dynamics of a rigid 
body. Both of the attitude dynamics and the proposed control 
system are globally expressed on the special orthogonal group, 
to avoid complexities and ambiguities associated with other 
attitude representations such as Euler angles or quaternions. 
By designing an adaptive law for the inertia matrix of a rigid 
body, the proposed control system can asymptotically follow 
an attitude command without the knowledge of the inertia 
matrix, and it is extended to guarantee boundedness of tracking 
errors in the presence of unstructured disturbances. These are 
illustrated by numerical examples and experiments for the 
attitude dynamics of a quadrotor UAV. 

I. Introduction 

The attitude dynamics of a rigid body appears in various 
engineering applications, such as aerial and underwater vehi- 
cles, robotics, and spacecraft, and the attitude control prob- 
lem has been extensively studied under various assumptions 
(see, for example, [1], [2], [3], [4]). 

One of the distinct features of the attitude dynamics is 
that its configuration manifold is not linear: it evolves on a 
nonlinear manifold, referred as the special orthogonal group, 
SO (3). This yields important and unique properties that 
cannot be observed from dynamic systems evolving on a 
linear space. For example, it has been shown that there exists 
no continuous feedback control system that asymptotically 
stabilizes an attitude globally on S0(3) [?], [5]. 

However, most of the prior work on the attitude con- 
trol is based on minimal representations of an attitude, or 
quaternions. It is well known that any minimal attitude 
representations are defined only locally, and they exhibit 
kinematic singularities for large angle rotational maneuvers. 
Quaternions do not have singularities, but they have ambigui- 
ties in representing an attitude, as the three-sphere S"^ double- 
covers S0(3). As a result, in a quaternion-based attitude 
control system, convergence to a single attitude implies 
convergence to either of the two disconnected, antipodal 
points on S"^ [6]. Therefore, depending on the particular 
choice of control inputs, a quaternion-based control sys- 
tem may become discontinuous when applied to an actual 
attitude dynamics [7], and it may also exhibit unwinding 
behavior, where the controller unnecessarily rotates a rigid 
body through large angles [5], [8]. 

Geometric control is concerned with the development of 
control systems for dynamic systems evolving on nonlinear 
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manifolds that cannot be globally identified with Euclidean 
spaces [9], [10], [11]. By characterizing geometric properties 
of nonlinear manifolds intrinsically, geometric control tech- 
niques completely avoids singularities and ambiguities that 
are associated with local coordinates or improper characteri- 
zations of a configuration manifold. This approach has been 
applied to fully actuated rigid body dynamics on Lie groups 
to achieve almost global asymptotic stability [11], [12], [13], 
[14], [15], [16]. 

In this paper, we develop a geometric adaptive controller 
on SO (3) to track an attitude and angular velocity command 
without the knowledge of the inertia matrix of a rigid 
body. An estimate of the inertia matrix is updated online to 
provide an asymptotic tracking property. It is also extended 
to a robust adaptive attitude tracking control system. Stable 
adaptive control schemes designed without consideration of 
uncertainties may become unstable in the presence of small 
disturbances [17]. The presented robust adaptive scheme 
guarantees the boundedness of the attitude tracking error 
and the inertia matrix estimation error even if there exist 
modeling errors or disturbances. Compared with a prior work 
in [15], the proposed adaptive tracking control system has 
simpler structures, and the proposed robust adaptive track- 
ing control system can be applied to unstructured or non- 
harmonic uncertainties without need for their frequencies. 

This paper is organized as follows. We present a global 
attitude dynamics model in Section [II] Adaptive attitude 
tracking control systems on S0(3) are developed in Section 
III, followed by numerical and experimental results. 

II. Attitude Dynamics of a Rigid Body 

We consider the rotational attitude dynamics of a fully- 
actuated rigid body. We define an inertial reference frame 
and a body fixed frame whose origin is located at the mass 
center of the rigid body. The configuration of the rigid body 
is the orientation of the body fixed frame with respect to 
the inertial frame, and it is represented by a rotation matrix 
R £ S0(3), where the special orthogonal group S0(3) is 
the group of 3 x 3 orthogonal matrices with determinant of 
one, i.e., S0(3) ^ {R e M^xs | ^t^ ^ deti? = 1}. 

The equations of motion are given by 

jn + fix ,m = u + A, (1) 

R = Rn, (2) 

where J G R^^'^ is the inertia matrix in the body fixed frame, 
and G M'^ and u e are the angular velocity of the 
rigid body and the control moment, represented with respect 



to the body fixed frame, respectively. The vector A e M."^ 
represents disturbances caused by either modeling errors or 
system noises. 

The hat map A : M'^ — > so (3) transforms a vector in M.'^ 
to a 3 X 3 skew-symmetric matrix such that xy ^ x x y for 
any x,y G M'^. The inverse of the hat map is denoted by the 
vee map V : so(3) M.^. Several properties of the hat map 
are summarized as follows: 



xy — X X y = —y x x = —yx, 
1 



(3) 



tiAx] = -tT[x{A - A^)] = -x'^iA - A^y, (4) 

(5) 
(6) 



xA + A^x^{{ty[A]h^s-A}xY 
RxR^ = (i?a;)^, 



for any x, y € M^, A e M^''^, and R G S0(3). Throughout 
this paper, the 2-norm of a matrix A is denoted by \\A\\, and 
its Frobenius norm is denoted by \\A\\f = ^/tilA'^A]. We 
have < \\A\\p < y/r\\A\\, where r is the rank of A. 

III. Geometric Tracking Control on S0(3) 

We develop adaptive control systems to follow a given 
smooth attitude command Rd{t) G SO (3). The kinematics 
equation for the attitude command can be written as 



Rd — Rd^d, 

where ild G M'^ is the desired angular velocity. 



(7) 



A. Attitude Error Dynamics 

One of the important procedures in constructing a control 
system on a nonlinear manifold Q is choosing a proper 
configuration error function, which is a smooth positive 
definite function ^E* : Q x Q — > M that measures the error 
between a current configuration and a desired configuration. 
Once a configuration error function is chosen, a configuration 
error vector, and a velocity error vector can be defined in 
the tangent space T^Q by using the derivatives of "if [11]. 
Then, the remaining procedure is similar to nonlinear control 
system design in Euclidean spaces: control inputs are care- 
fully designed as a function of these error vectors through a 
Lyapunov analysis on Q. 

The following form of a configuration error function has 
been used in [11], [14]. Here, we summarize its properties 
developed in those literatures, and we show few additional 
facts required in this paper 

Proposition 1: For a given tracking command {Rd, ilrf), 
and the current attitude and angular velocity (R, 57), we 
define an attitude error function '5 : S0(3) x S0(3) — )• M, 
an attitude error vector eji : S0(3) x S0(3) — ?> K^, and an 



angular velocity error vector en : SO (3); 
as follows: 



(S0(3); 



^iR,Rd) = -tr[GiI-RjR)], 
eR{R,Rd) = -{GRJR — R^RdCy , 

en{R,n,Rd,n) = n-R^Rdnd, 



(8) 

(9) 
(10) 



where the matrix G G M.^^^ is given by G = diag[(7i, (727 53] 
for distinct, positive constants 51,(72,33 G IR- Then, the 
following statements hold: 

(i) 4* is locally positive definite about R = Rd- 

(ii) the left-trivialized derivative of 'f is given by 



T*jLr (D«^'(i?,i?d)) = efl. 



(11) 



(iii) the critical points of where = 0, are {Rd} U 
{i?dexp(7rs)} for s G {61,62,63}. 

(iv) a lower bound of vj/ is given as follows: 



biWeMRdW <'fiR,Rd), 
where the constant bi is given by hi = 



(12) 



for 

hi = min{gi + 52, 92 + 93, 93 + 5i}, 

/i2 max{(.gi - 52)^, (ff2 - 53)^, {93 - gif}, 

/13 = max{(.gi + 52)^, {92 + 93^, (.93 + 9if}- 

(v) Let 1/' be a positive constant that is strictly less than hi. 
If ^{R,Rd) < < hi, then an upper bound of 4' is 
given by 



^{R,Rd) <b2\\eR{R,Rd)f, 
where the constant 62 is given by &2 = h^'(^hil 



(13) 
for 



/14 = max{gi + 52, 92 + 93, 93 + 9i} 

/15 min{(.gi + 52)^, (32 + 53)^, (33 + 9if}- 
Proof: The proofs of (i)-(iii) are available at [11, (Chap. 
11)]. To show (iv) and (v), let Q = RJR = cxpx G SO (3) 
for a; G M'' from Rodrigues' formula. Using the Matlab 
Symbolic Computation Tool, we find 



1 



2 X 



9])xl, 



(1 



4||a;||4 

sin^ 1 1 a; I 
4||a;|P 



(ij,fc)ec 

^ ^ {9.-9,fxix] 



9,Y 



where C = {(1, 2, 3), (2, 3, 1), (3, 1, 2)}. When ^ = Q, ^ 
is trivial. Assuming that 5* 7^ 0, therefore ||a;|| 7^ 0, an upper 
bound of ^^'^'^^ is given by 



1 



1 



h2 + ft.3 



< 



hi 



which shows ( [T2] l. 

Next, we consider (v). When 5" = 0, ( [T3] l is trivial. 
Hereafter, we assume ^ Q, therefore R ^ Rd- At the 
three remaining critical points of 4*, the values of ^ are 
given by gi + 52, 92 + 93, or 53 + gi- So, from the given 
bound < ^/j, these three critical points are avoided, and we 



can guarantee that e/? ^ and ||a;|| < tt. An upper bound of 
plip is given by 



To show pTjl, we find the Frobenius norm H-EHf^ 



< 



2(1 -cos 11x11) Y.c^a,^g,)xll\\x\\ 



< 



sin 1 1 X 
2 



1^ Eci9^ + 9,y4/\M 



1 + COS 1 1 a; II /i5 
Also, an upper bound of hi ~ ip is given by 

1 ^ cos ||a:|| , hi , 

hi-^ <hi--^ <hi " y ^ 



(14) 



\\E{R,Rd)\\F - ^tiWE] = i^tr[G2] +tr[i?^i?dG]', 

(22) 

where we use the facts that tr[A_B] = tr[i?A] and tr[cA] = 
ctr[A] for any matrices A, B, and a constant c. Let Q = 
rJr = expx £ SO (3) for x e from Rodrigues' 
formula. Using the Matlab Symbolic Computation Tool, we 
find 



cos \ x\ 



Substituting this into (14i, we have 



tT[R^RaG] = cos ||x||^ 3,(1- 



< 



h^hi 



l|ei?ir h{hi-^) 
which shows ( [T3] l. ■ 
The corresponding attitude error dynamics for the attitude 
error function ^t, the attitude error vector e/j, and the angular 
velocity error eo are as follows. 

Proposition 2: The error dynamics for cr, en satisfies 

'^-(i?Ji?) = i?Ji?en 



Since < x'i/\\xf < 1, we have tr[i?^i?rfG] < J2Ll9^ 
tr[G]. Substituting this into p2| ), we obtain 

tr[G]^) < ^tr[G]^ 



\E{R,R,i)\\%<-itT[G'] 



en 



dt 

— (^'(i?,i?d)) = efl-en, 

gr = E{R, Rd)en, 
J"^(-r2 X Jf} + u + A) - ad, 



(15) 

(16) 
(17) 
(18) 



which shows j2T)^ince ||i?|| < ||i?||F- 

From ([l]i, (|^ir([7|, and using the fact that Cld^d — ^d ^ 
fid ~ for any fi^ e M^^, the time-derivative of the angular 
velocity error en is given by 

ejl = + flR'^Rd^d — R^ Rd^d^d — R^Rd^d 

= J-\-Q X .m + u + A) + ClR^Rdnd - R^Rd^d, 
= J"^(-f7 X JO + It + A) - ttd, 



where the matrix E{R, Rd) £ R^""^, and the angular accel- where ad is given by 
eration ad € R^, that is caused by the attitude command, 
and measured in the body fixed frame, are given by 

EiR,Rd) = ^itT[R^RdG]I-R^RdG), (19) 
ad - -ClR^Rd^d + R^Rdtld. (20) 
Furthermore, the matrix E{R, Rd) is bounded by 

\\E{R,Rd)\\<^iAG]. (21) 
V 2 

Proof: From the kinematics equations d2|), (ITjl, the time- 
derivative of R^R is given by 



B. Adaptive Attitude Tracking 

Attitude tracking control systems require the knowledge 
of an inertia matrix when the given attitude command is not 
fixed. But, it is difficult to measure the value of an inertia 
matrix exactly. In general, there is an estimation error, given 
by 



J = J - J, 



(23) 



dt 



[R^R) — — fldR'd R + Rd Re- 



using (|6]l, this can be written as 

d 



dt 



(i?^ R) = i?i Ri~{R' Rd^dr + 



which shows ( fTSj ). From this, the time-derivative of the 
attitude error function is given by 

j^^iR,Rd) = -ltT[GR^Ren] 

Applying (|9]l into this, we obtain ( [T6| . Next, the time- 
derivative of the attitude error vector is given by 

en = ^{GR^^Ren + enR^ RdGY . 

Using the properties of the hat map, given by (jSjl, this can 
be further reduced to ( [T7| ) and ([T9]l. 



where the exact inertia matrix and its estimate are denoted by 
the matrices J and J e M'^^^, respectively. All of matrices, 
J, J, J are symmetric. 

Here, an adaptive tracking controller for the attitude 
dynamics of a rigid body is presented to follow a given 
attitude command without the knowledge of its inertia matrix 
assuming that there is no disturbance, and that the bounds 
of the inertia matrix are given. 

Assumption 3: The minimum eigenvalue A„i G R, and the 
maximum eigenvalue Am G M of the true inertia matrix J 
given at ([T]) are known. 

Proposition 4: Assume that there is no disturbance in the 
attitude dynamics, i.e. A = at ([T|i, and Assumption [5] is 
satisfied. For a given attitude command Rd{t), and positive 
constants k^, kn, kj E R, we define a control input u E M'^, 
and an update law for J as follows: 



u = -kjien - knen + x Jfl + Jad, 



(24) 



J = y (-adGA - e^al + ^^'^eA ~ eA^n^), (25) 



where ca G M.^ is an augmented error vector given by 



From (21 1, it is bounded by 



BA = en + ceR 
for a positive constant c satisfying 



(26) 



c < mm ■ 



/2kc 



' AMtr[G] ' kf, 



^/2 



(27) 



Then, the zero equilibrium of the tracking errors (e/j, cq) 
and the estimation error J is stable, and those errors are 
uniformly bounded. Furthermore, the tracking errors for the 
attitude and the angular velocity asymptotically converge to 
zero, i.e. e^ , esi — > as i — > oo. 

Proof: Consider the following Lyapunov function: 

V=len- Jen + Rd) + cJen ■ eR + -^|| J||^. 

2 2k J 

(28) 



From ( [T2| l, we obtain 



2 Wnz < V 



(29) 



where z = [\\eR\\; \\en\ 
]g3x3 ^j-g given by 



\J\\f] e and the matrix Wi G 



bikR 

^cXm 




2 









1 

2/C.7 



(30) 



Substituting (|24]) into (|T8]l with A = 0, we obtain 

Jeo = — X jrt — J ad — kRCR — k^en + fl x JO, + Jud, 
= -kRCR - knefi - Jud - 17 x JO,. (31) 

Using ( [T6] ), ( [Tt] ), ( 3 1 1, the time-derivative of V is given by 

V ^ en - {-kRCR - knen - Jad - 11 x Jf2) 

+ kRCR ■ en + c{-kReR - knen - Jad - ^ x J^) ■ eR 



1 



+ cJen ■ Een + -^tr 
k.j 

= -kn\\en\\^ - ckR\\eR 



JJ 



cJen ■ Een - cknen ■ eR 



1 



{en + ceR) ■ {Jad + 11 x Jil) + — tr 

kj 



JJ 



From (26 1, and using the fact that x-y = lT[xy^] — \.x\yx^\ 
for any x, i/ G M-^, and the scalar triple product identity, this 
can be written as 

V^-kn\\enf 



tr 



J 



T 

-OLdeA 



cfci?,||efl|p + cJen ■ Een 
VL{eA X 



cknen ■ cr 



Since J = — J, we can substitute (25 1 into this. Using the 
facts that tr[JA] = tr[JA^] for any A e R^""^, and (e^ x 
H)^ = (e^iil)-^ = — ll-'^eA, it reduces to 

V = -fco||eo|P - ckR^leRW^ + cJen ■ Een - cknen ■ cr. 

(32) 



V < -{k. 



-MMGrnenf - ckR\\eR\ 



V2 

ckn\\en\\\\eR}\ = -C'^W2C, 



where C = [WcrW 
is given by 

Wo = 



\\en\\] e M^, and the matrix W2 e 



_ ckg 
2 



\/2 



'fcn 

AMtr[G] 



(33) 



(34) 



The inequality ( [27| for the constant c guarantees that the 
matrices Wii,W2 are positive definite. 

This implies that the Lyapunov function V{t) is bounded 
from below and it is nonincreasing. Therefore, it has a limit, 
limt^ooV(t) = Voo, and eR,en,J e £00 From ( [T7| , 
( [3T] i, we have eR,en € £00 ■ Furthermore eR,en & £2 
since C{'^VW2C{T)dT < V(0) - Voo < 00. According 
to Barbalat's lemma (or Lemma 3.2.5 in [17]), we have 
cr, eo as < 00. ■ 

Remark 5: This proposition guarantees that the attitude 
error vector cr asymptotically converges to zero. But, this 
does not necessarily imply that R —i' Rd as t 00. Ac- 
cording to Proposition [l] there exist three additional critical 
points of namely {Rdexp{TTs)} for s e {61,62,63}, 
where eR — 0. This is due to the nonlinear structures of 
SO (3), and these cannot be avoided for any continuous 
control systems [18], [5]. 

But, we can show that those three additional equilibrium 
points are unstable, by using linearization or by showing 
that the hessian of 5* is indefinite at those points. It turned 
out that these points are saddle equilibria, which have both 
of stable manifolds and unstable manifolds [19]. The union 
of the stable manifolds to these undesirable equilibria has a 
lower dimension than the tangent bundle of the configuration 
space, and we say that it has an almost-global stabilization 
property. 

Remark 6: At Assumption[3] the minimum eigenvalue Am 
and the maximum eigenvalue Am of the inertia matrix J are 
required. But, in Proposition |4] they are only used to find 
the coefficient c at (27 1. So, Assumption |3] can be relaxed as 
requiring an upper bound of Am and a lower bound of Xm, 
which are relatively simpler to estimate. 

C. Robust Adaptive Attitude Tracking 

The adaptive tracking control system developed in the 
previous section is based on the assumption that there is 
no disturbance in the attitude dynamics. But, it has been dis- 
covered that adaptive control schemes may become unstable 
in the presence of small disturbances [17]. Robust adaptive 
control deals with redesigning or modifying adaptive control 
schemes to make them robust with respect to unmodeled dy- 
namics or bounded disturbances. In this section, we develop 
a robust adaptive attitude tracking control system assuming 
that the bound of disturbances are given. 

'a function / : M — > R belongs to the Cp space for p £ [1, 00), if the 
following p-norm of the function exits, ||/||p = {/q°° dr}^^^ . 



Assumption 7: The disturbance term in the attitude dy- 
namics at (jT|) is bounded by a known constant, i.e. || A|| < 6 
for a given positive constant S. 

Proposition 8: Suppose that Assumptions |3] and |7] hold. 
For a given attitude command Rd{t), and positive constants 
kji,kfi,kj,(T,e E M, we define a control input u G M'^, and 
an update law for J as follows: 



Z? X R'' X : 



"<5||e^||+e' 



X Jfl + Jad 



j kj J, 



(35) 
(36) 

2a J), 
(37) 




Fig. 1. Boundedness of the error: Outside of the shaded region, repr esented 
[^(tXIj + e)}, we have V < from j42|. Inside 

- -Tiuiia < ^/fej} C DxM^ xR3x»7Fquations 



where ba & R is an augmented error vector given at ( |26[ ) set of V in B. 



by {An,in(W3)||z||2 > (| 

of the larger ball, 

j38| and |44j hold. The inequality ^45) guarantees that the smallest sublevel 
set of V, covering the shaded area, lies inside of the largest sublevel 



for a positive constant c satisfying (27i. Then, if a and e are 
sufficiently small, the zero equilibrium of the tracking errors 
(e_R,eo) and the estimation error J are uniformly bounded. 



Ldi C Ldj ■ Therefore, along any solution 



Proof: Consider the Lyapunov function V at (28 1. For 
a positive constant tp < hi, define D C S0(3) as 

£> = {i? e S0(3) I * < < /ii} 

From Proposition [T] the Lyapunov function is bounded in D 
by 



Z^WllZ < V < Z^Wl2Z, 



(38) 



\J\\f] e K^, the matrix Wn e 



where z = \\\eR\\- \\en\ 

]gi2x2 given by (30i, and the matrix W12 is given by 



hkR 











1 

2k J 



The time-derivative of V along the presented control inputs 
is written as 



V = ~kn\\enf 
+ • (A 4 



ckiiWeiiW +cJen-Ee: 



n 



atr 



JJ 



cknen ■ cr 
(39) 



Compared with p2| ), this has three additional terms caused 
by A, u and a. From Assumption [7] and (36 1, the second last 
term of ([39]) is bounded by 



eA • (A + f) < SWcaW 



S\\eA\\+e 



S\\eA\ 



S\\eA\ 



-e < e. 



(40) 



The last term of ([39]l is bounded by 



tr 



JJ 



tr[j(J- 



1 .0 



l<i,j<3 



2 



E ( 

l<i.j<3 
1 



Jij Jij ) 



:Jf.) = -^tr 



J' 



1, 



Ull 



2"""" ' 2' 

Using the relation between a Frobenius norm and a matrix 
2-norm, we have \\J\\f < \/3||J|| = V^Xm- Therefore, 



tr 



JJ 



< 



1. 



\J 



M- 



(41) 



starting in L^j, , V decreases until the solution enters L^i ■ thereby yielding 
uniform boundedness. 



Substituting (|40|l, (|4T| into (|39]l, we obtain 

3 

— f 
2 



M 



where the matrix W-^ £ 



p3x3 



ckR 

2 





is given by 




(42) 



(43) 



The inequality ( 27 1 for the constant c guarantees that the 
matrices Wii,Wi2, W3 become positive definite. Then, we 
have 



V < 



Xyain{W2) 
Amax(W^i2) 



(44) 



where A,nin(0 and Ainax(-) represent the minimum eigen- 
value and the maximum eigenvalue of a matrix, respectively. 
This implies that V < when V > ^^f^r^^i^f^^^li + e) = 
di. 



Let a sublevel set of V be L..^ = {iR,n, J) e S0(3) 



p3x3 



} I V < 7} for a constant 7 > 0. If the following 



inequality for 7 is satisfied 



7 < f A„,i„(M^n) = d2, 
02 



we can guarantee that C Dx] 
that 



p3x3 



since it implies 



\zf < f , which leads ^' < ^alleflf < b2\\zf < i). 



Then, from (44i, a sublevel set is a positively invariant 



set, when di < 7 < ^2, and it becomes smaller until 7 = di. 
In order to guarantee the existence of such L^, the following 
inequality should be satisfied 

'^l = ri^^o^^A^ +'^l< T-Ami„(T^ll) = d2, 

Amin(,^V'3j ^ O2 



(45) 

which can be achieved by choosing sufficiently small a and 
e. Then, according to Theorem 5.1 in [20], for any initial 



condition satisfying V(0) < o?2> its solution exponentially 
converges to the following set: 

Amax(W^12) /3 

(W^ii)A„,i„(W^2) V 2 



Ld, C 



\z\?< 



Remark 9: The robust adaptive control system in Propo- 
sition [8] is referred to as fixed cr-modification [17], where 
robustness is achieved at the expense of replacing the asymp- 
totic tracking property of Proposition |4] by boundedness. 
This property can be improved by the following approaches: 

(i) the leakage term —2aJ at ( (37| can be replaced by 
—2a{J — J*), where J* denotes the best possible prior 
estimate of the inertia matrix. This shifts the tendency of 
J from zero to J*, thereby reducing the ultimate bound, 

(ii) a switching -modification or ei -modification can be 
used to improve the convergence properties in the expense of 
discontinuities, (iii) the constant e at ( [36| can be replaced by 
eexp{—/3t) for any /3 > to reduce the ultimate bound. The 
corresponding stability analyses are similar to the presented 
case, and they are deferred to a future study. 

IV. Numerical Examples 

Parameters of a rigid body model and control systems are 
chosen as follow^! 

-5.156 X 10"^ 
1.059 X 10-2 
-1.026 X 10-^ 

kn = 0.0296, 



J 



1.059 X 10-2 
-5.156 X 10-^ 
2.361 X 10-5 

kn = 0.0424, 



2.361 X 10-^ ■ 
-1.026 X 10-5 
1.005 X 10-2 

fcj = 0.1, 

S = 0.2. 



c=1.0, cr = 0.01, £ = 0.002, 
Initial conditions are given by 

j(o) = 0.001/, i?(o) = /, n{o) = 0. 

The desired attitude command is described by using 3-2- 
1 Euler angles [21], i.e. i?d(t) = Rd{cj){t),e{t),iP{t)), and 
these angles are chosen as 



■sin(7ri), 9{t) — — cos{iTt), 'ip{t) 



0. 



We consider three cases: 

(i) Adaptive attitude tracking control system presented at 
Proposition |4] without disturbances. 

(ii) Adaptive attitude tracking control system presented at 
Proposition |4] with the following disturbances: 

A = 0.1 [sin(27ri) cos(57rt) Rii{t)] . 

(iii) Robust adaptive attitude tracking control system pre- 
sented at Proposition |8] with the above disturbance 
model. 

It has been shown that general-purpose numerical integra- 
tors fail to preserve the structure of the special orthogonal 
group SO (3), and they may yields unreliable computational 
results for complex maneuvers of rigid bodies [22], [23]. 
In this paper, we use a geometric numerical integrators, 

-AH of variables are defined in kilograms, meters, seconds, and radians 
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Fig. 2. Adaptive attitude tracking without disturbances 

referred to as a Lie group variational integrator, to preserve 
the underlying geometric structures of the attitude dynamics 
accurately [24]. 

Simulation results are illustrated at Figures 2]|4 When 
there is no disturbance, the adaptive attitude tracking control 
system presented at Proposition |4] follows the given attitude 
command accurately while making the estimate of the inertia 
matrix converge to a fixed matrix at Fig. |2] But, these 
convergence properties are degraded in the presence of 
disturbances. At Fig.|3] the tracking errors are not converged 
to zero asymptotically, and the estimate of the inertia matrix 
and control inputs fluctuate. These are significantly improved 
by the robust adaptive tracking controller discussed at Propo- 
sition |8] At Fig. [4] the tracking errors for the attitude and 
the angular velocity are close to zero, and the estimate of 
the inertia matrix is bounded. These show that the proposed 
robust adaptive approach is critical in following an attitude 
command in the presence of disturbances. 

V. Experiment on a Quadrotor UAV 

A quadrotor unmanned aerial vehicle (UAV) is composed 
of two pairs of counter-rotating rotors and propellers. Due 
to its simple mechanical structure, it has been envisaged for 
various applications such as surveillance or mobile sensor 
networks as well as for educational purposes. 

We have developed a hardware system for a quadrotor 
UAV. It is composed of the following parts: 

• Gumstix Overo computer-in-module (OMAP 600MHz 
processor), running a non-realtime Linux operating sys- 
tem. It is connected to a ground station via WIFI. 

• Microstrain 3DM-GX3 attitude sensor, connected to 
Gumstix via UART. 

• Phifun motor speed controller, connected to Gumstix 
via I2C. 



0.5p 
-0.5- 



5 


5 

5 " 

5 

-5, 



0.05 1 



5 10 15 20 



5 10 15 20 5 10 15 20 

f t 

(a) Attitude error vector en (b) Angular velocity (f2:blue, Q^:red) 

0.5 1 ' ' ' 1 



(a) Attitude error vector ejj 




\^^^,M^,rV^^/V\/^A^A^A/YV^f 



5 



10 



15 



20 



ilf!;/J\/l\lpfl\^ 



%Jjjti'^{tjv^^)\i'v'^MMjl)/^j^VJ{4/^I^^t^^ 



0.01 


-0.0 
» 5 

IK^ 

'^-5, 





X 10""' 



V V V 




i "/vAAAAAAAA/^ 



?VVWWVVVWVVVWW\A 



(b) Angular velocity (f2:blue, Q^jired) 





-«-=o 



yVVVVVVAAAAA/WWvV\/' 
^ 10 15 20 



= 

0.1 




(c) Inertia estimate J (Jn, Ji2:solid, 
-/22, -'i3:dashed, J33, J23:dotted) 



(d) Control input u 
Fig. 3. Adaptive attitude tracking with disturbances 



(c) Inertia estimate J (Jn, Ji2:solid, 
J22, Ji3:dashed, J33, J23:dotted) 



5 10 15 

t 

(d) Control input u 



Fig. 4. Robust adaptive attitude tracking with disturbances 



• Roxxy 2827-35 Brushless DC motors. 

• MaxStream XBee RF module, which is used for an extra 
safety switch. 

To test the attitude dynamics only, it is attached to a spherical 
joint. As the center of rotation is below the center of gravity, 
there exists a destabilizing gravitational moment, and the 
resulting attitude dynamics is similar to an inverted rigid 
body pendulum. 

We apply the robust adaptive attitude control system at 
Proposition [8] to this quadrotor UAV. The control input at 
( 35 I is augmented with an additional term to eliminate the 
gravitational moment. The disturbances are mainly due to 
the error in canceling the gravitational moment, the friction 
in the spherical joint, as well as sensor noises and thrust 
measurement errors. 

The attitude tracking command and control input parame- 
ters are identical to the numerical examples discussed in the 
previous section, except the following variables: 

A:j = 0.01, (T = 0.01, 6 = 0.35. 



The corresponding experimental results are illustrated 
at Fig. |6] Overall, it exhibits a good attitude command 
tracking performance, while the second component of the 
attitude error vector e/j, and the third component of the 
angular velocity tracking error are relatively large. The 
estimates of the inertia matrix are bounded (a video clip 
showing the controlled attitude maneuver is available at 
|http://my.fit.edu/~taeyoung/Animation/QuadRAC.mov| . 

VI. Conclusion 

We have developed adaptive tracking control systems on 
SO (3). The proposed control system is constructed directly 
on SO (3) to avoid singularities and ambiguities that are 



inherent to other attitude representations. A adaptive control 
system is developed to asymptotically follow a given attitude 
tracking command without the knowledge of an inertia ma- 
trix, in the absence of disturbances. A robust adaptive control 
system is proposed to eliminate the effects of disturbances. 
These properties are illustrated by numerical examples and a 
hardware experiment of the attitude dynamics of a quadrotor 
UAV. 
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